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Description 



The present invention relates to a control device for 
a robot that operates in an inertia! coordinate system, in 
other words, one that operates in an inertial region such s 
as in space or under the sea where the force of gravity 
cannot be used. In particular, it relates to a control 
device for a robot that moves a robot arm to perform a 
task while free flying in space or under the sea. 

With conventional techniques (see for example US- w 
A-4580229 describing the closest prior art), if a hand of 
a floating robot arm is to be made to follow a target path 
in an operating coordinate system (an inertial system), 
the main body of the robot is forced to move by the reac- 
tion force generated by the arm's movement, and this 75 
causes a problem in that it is difficult for the hand to 
accurately follow the path. 

A technique of generating velocity instructions by 
taking into consideration the dynamic behavior of the 
entire system, including the main body of the robot, has 20 
been proposed in "Resolved Motion Rate Control of 
Space Robotic Manipulators with Generalized Jacobian 
Matrix", by Umetani and Yoshida, Jaurnal of the Robot- 
ics Society of Japan, Vol. 7, No. 4, pp. 63-73, 1989. 
Since this technique provides velocity control, the prob- 25 
lem remains of how to generate target position and ori- 
entation instructions, and the method used to generate 
velocity instructions necessitates massive calculations 
such as computations of mass characteristics, centers 
of mass, and inertial tensors for each robot arm, so the 30 
technique cannot cope readily with changes in parame- 
ters. 

Various other techniques have been proposed for 
controlling movement of the main robot body caused by 
reaction force, by adding propulsion actuators to the 35 
main robot body or by adding torquers that generate 
torque. These techniques are described in papers such 
as "On the Dynamics of Manipulators in Space Using 
the Virtual Manipulator Approach," 2. Vafa and S. 
Dubowsky, Proc IEEE Int. Conf. on Robotics & Automa- 40 
tion, pp. 579-585 (1987), and "Experiments on the Con- 
trol of a Satellite Manipulator," H.L Alexander and R.H. 
Cannon, Proc. Material Handling Research Focus, 
Georgia Institute of Technology, pp. 1-10 (1986). How- 
ever, these techniques require some form of propulsion 45 
generation means or torquer, so they are not advanta- 
geous from the energy-saving point of view. 

Other proposed techniques for controlling a robot 
use sensors in the end of the robot hand to measure a 
relative position or relative velocity toward an object that so 
the robot hand is to approach, and feed this value back 
to the robot to control it. Such techniques are described 
in, for example, "Sensor Feedback Control of Space 
Manipulators," by Masutani, Miyazaki, and Arimoto, 
Pre-prints of Fifth Lectures of Robotics Society of 55 
Japan, pp. 245-248. 1987. Since these techniques 
require a target object, and they also require something 
to act as some sort of verification mark as well, they 
cannot be used to move a hand of a robot arm in a 



desired manner in places where 
ing objects. 



SUMMARY D F THE INVFNTIONl 




'e are no surround- 



An objective of the present invention is to provide a 
robot control device in an inertial coordinate system that 
has a simple construction and that can accurately deter- 
mine the position of an arm in an inertial frame in which 
a task is performed, and can drive the arm. 

According to the present invention, there is pro- 
vided a control device for a robot in an inertial coordi- 
nate system, comprising: a robot provided with an arm 
in a main robot body thereof, said arm being drivable; a 
desired value setting means for setting a desired value 
expressed in an absolute coordinate system in an iner- 
tial system of said arm; a detection means for detecting 
a velocity or acceleration expressed in a robot coordi- 
nate system of said main robot body; and a control 
means for correcting said desired value in response to 
outputs from said desired value setting means and said 
detection means, whereby said robot arm is driven in 
accordance with the thus-corrected value. 

In accordance with the present invention, a main 
robot body is provided with a detection means that 
detects a velocity or an acceleration expressed in a 
robot coordinate system with respect to the main robot 
body, an output from the detection means is superim- 
posed as a correction to a desired value of an arm, 
expressed in an absolute coordinate system and output 
from a desired value setting means, and a modified path 
is generated for the arm in an inertial reference frame. 
Therefore, even if the main robot body changes position 
while floating in the inertial reference frame, the arm can 
be made to accurately achieve any desired target value. 

The arm can be made to move along a desired path 
even when there are no target objects or marks, and 
there is no need for means of generating propulsion 
forces for the main robot body or means of generating 
torque. In other words, all that is necessary is that the 
velocity or acceleration of the main robot body is 
detected by the detection means mounted in the main 
robot body, and a correction is added to a path instruc- 
tion which is a desired value of the arm generated when 
the main robot body is assumed not to be moving, so 
that accurate path control can be enabled for the arm. 
Therefore, the present invention ensures that it is no 
longer necessary to accurately identify each of the 
physical constants of the robot arm, and the arm can be 
made to follow any desired target path without needing 
any kind of modification, even if a parameter of the arm 
should change. 

Therefore, since there is no need for a target object 
or mark with the present invention, the arm can be 
made to achieve a desired value or follow a desired path 
without having to deviate within the environment. Since 
there is no need for means of obtaining a propulsion 
force for the main robot body or a means of generating 
torque, the present invention has a significant energy- 
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saving effect, and since there ia|^need to identify and 
calculate physical constants fo^Bi individual arm, th* 
load on the processing means^Kh as a computer can ' 
be reduced, increasing robust controllability. 

5 

BRIEF DESCRIPTION OF THE DRAWINGS 

Figure 1 is a block diagram of the entire structure of 
one embodiment of the present invention; 
Fig. 2 is a simplified side view of a robot 1 ; to 
Fig. 3 is a block diagram showing a structure relat- 
ing to an acceleration detection means 14; 
Fig. 4 is a block diagram showing a structure relat- 
ing to a velocity detector 18 of another embodiment 
of the present invention; 15 
Fig. 5 shows a simplified robot 1 illustrating the 
results of experiments making use of the present 
invention; 

Fig. 6 shows the results of experiments making use 
of the present invention; and 20 
Fig. 7 is a simplified diagram of a robot 1a used as 
a comparison example. 

DESCRIPTION OF THE PREFERRED EMBODI- 
MENTS 25 

A block diagram of the entire structure of one 
embodiment of the present invention is shown in Fig. 1, 
and a simplified side view of a robot thereof is shown in 
Fig. 2. A robot 1 floats in an inertial system such as in 30 
space or under the sea where the force of gravity cannot 
be used. This robot 1 is configured of a mam robot body 
2 and a number of arms 3 (for example, six arms) that 
each have a number of degrees of freedom, and an 
operating end 4 of each of the arms 3 is able to perform 35 
a task in ah inertial reference frame. The main robot 
body 2 is provided with a detection means 14 that 
detects acceleration. When it is assumed that the main 
robot body 2 is not moving, processing circuitry 6 real- 
ized by a microcomputer or the like extracts signals indi- 40 
eating an instruction position xc. an instruction velocity 
xc, and an instruction acceleration xc expressed in 
absolute coordinates within the inertial reference frame, 
and sends them via adder circuits 8, 9, and 10 to a 
servo controller 1 1 . This servo controller 1 1 drives drive 45 
means of the arms 3 of the robot 1. The current position 
x of the operating end 4 of each arm 3, expressed in a 
coordinate system fixed with respect to the main robot 
body 2, is calculated from values from position detec- 
tors at each of the joints of the arm 3 and from the so 
lengths of links forming the arm 3. The current velocity 
x of the operating end 4 of the arm 3 is also calculated 
using outputs of velocity detectors or differential calcu- 
lus on outputs of position detectors at each of the joints 
of the arm 3, and from the link lengths. A calculation cir- 55 
cuit 12 generates the current velocity x of the operating 
end 4 of the arm 3 from the position of each of the joints 
of the arm 3, in coordinates fixed with respect to the 
main robot body 2, and a calculation circuit 13 gener- 



ates the current posi^Aof the operating end 4 of the 
arm 3 from the veloc^W each of the joints of the arm 

3, jn coordinates fixed with respect to the main robot 
body 2, but any means similar to a coordinate conver- 
sion calculator for a general-purpose fixed industrial 
robot may be used therefor. 

In Fig. 1, e and c represent the displacement and 
velocity of each of the joints of the arm 3. The signals 
indicating the current velocity x and the current position 
x are sent to the servo controller 1 1 which applies neg- 
ative feedback control to make the operating end 4 of 
the arm 3 achieve desired values supplied from the 
adder circuits 8, 9, and 10. 

The acceleration detection means 14 in accord- 
ance with the present invention is mounted in the main 
robot body 2. This acceleration detection means 14 
detects the acceleration of the main robot body 2 in the 
robot coordinate system. 

An acceleration xs in the robot coordinate system 
detected by the acceleration detection means 14 is sent 
from a calculation circuit 15 to a coordinate conversion 
calculation circuit 16, it is converted from the robot coor- 
dinate system to an absolute coordinate system (inertial 
coordinate system), and a thus-converted displacement 
Axe, velocity Axe, and acceleration Axe for the main 
robot body 2 are extracted and sent to the correspond- 
ing adder circuits 8, 9, and 10. 

A block diagram of a specific example of the struc- 
ture relating to the acceleration detection means 14 is 
shown in Fig. 3. The acceleration xs detected by the 
acceleration detection means 14 is integrated by an 
integration means 17 of the calculation circuit 15, to 
obtain a velocity xs of the main robot body 2, and this is 
further integrated by another integration means 18 to 
obtain a displacement xs. The acceleration xs detected 
by the acceleration detection means 14 and the velocity 
xs and xs based thereon are all expressed in the robot 
coordinate system, and they are converted by the coor- 
dinate conversion calculation circuit 1 6 described above 
to obtain the corresponding displacement Axe, velocity 
Axe, and acceleration Axe in the absolute coordinate 
system that is the inertial reference frame. 

A detection means 19 that detects the velocity of 
the main robot body 2 could be provided as another 
embodiment of the present invention, as shown in Fig. 

4. In this case, the velocity xs in the robot coordinate 
system is detected by the velocity detection means 19 
and is integrated by an integration circuit 18 to obtain a 
displacement xs in the robot coordinate system. These 
values xs and xs in the robot coordinate system are 
sent to a coordinate conversion calculation circuit 16, to 
obtain a displacement Axe and velocity Axe in the abso- 
lute coordinate system (the inertial reference frame) 
that are sent to adder circuits 8 and 9. In this embodi- 
ment, the adder circuit 10 is omitted, and the instruction 
acceleration xc is not generated. 

Results of experiments using the present invention 
are shown in Fig. 5. The main robot body 2 of the robot 
1 is provided with an arm 3 that has three degrees of 
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freedom, and the status at each instant as the operating 
end 4 is made to draw a circle by movement of the arm 
3 is shown. The circle drawn using the operating end 4 
is illustrated by the shape denoted by reference number 
20 in Fig. 6. The desired path that consists of target val- 
ues of the operating end 4 in the inertia! system is 
denoted by reference number 21 . It is clear from this fig- 
ure that use of the present invention ensures that the 
operating end 4 can be moved through a path extremely 
close to the desired path in the inertial system. 

In contrast, although a main robot body 2a of a 
comparison example shown in Fig. 7 is provided with a 
similar arm 3a, the main robot body 2a does not have 
the detection means 14 or 18 of the present invention. 
In this case, the operating end 4 thereof draws a greatly 
abbreviated oval path, as shown by reference number 
22 in Fig. 6, in comparison with the desired path 21 in 
the inertial system. Therefore it is clear from this figure 
that this path diverges widely from the target path 21 . 

This experiment shows that the robot arm of the 
present invention can accurately follow a path in an iner- 
tial system. 



Claims 



3. 



A control device for a robot in an inertial coordinate 
system, comprising: 

a) a robot provided with an arm (3) in a main 
robot body (2) thereof, said arm being drivea- 
ble; 

b) desired value setting means (6. 8-10) for set- 
ting a desired value (Xc, Xc, Xc) expressed in 
an absolute coordinate system in the inertial 
system of said arm; 

c) detections means (14, 19) for detecting a 
velocity or acceleration; and 

d) control means (11) for correcting said 
desired value from said desired value setting 
means (6, 8-10) in response to outputs from 
said detection means (14, 19) and for driving 
said robot arm in accordance with the thus-cor- 
rected value, 

characterized in that 

e) said robot is freely movable in said inertial 
coordinate system, and 

0 said detection means (14, 19) detects a 
forced Movement of the main robot body 
expressed in a local robot coordinate system. 

A control device for a robot in accordance with 
claim 1, wherein said detection means comprises a 
velocity meter (19) mounted in said main robot 
body and an integrator (18) for generating a posi- 
tion signal from an output from said velocity meter. 

A control device for a robot in accordance with 
claim 1 or 2, wherein said detection means further 
comprises a coordinate conversion calculation 
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means (4) for converting a vSTocity and a position 
expressed in said robot coordinate system into a 
velocity and a position expressed in said absolute 
coordinate system. 

A control device for a robot in accordance with 
claim 1, wherein said detection means comprises 
an accelerometer (14) mounted in said main robot 
body and a two-stage integrator (17, 18) for gener- 
ating both a velocity signal and a position signal 
from an output from said accelerometer. 

A control device for a robot in accordance with 
claim 4, wherein said detection means further com- 
prises a coordinate conversion calculation means 
(4) for converting an acceleration, a velocity, and a 
position expressed in said robot coordinate system 
into an acceleration, a velocity, and a position 
expressed in said absolute coordinate system. 
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Patentanspruche 

1 - Steuervorrichtung fur einen Roboter in einem Trag- 
heitskoordinatensystem, umfassend: 

a) einen Roboter mit einem antreibbaren Arm 
(3) in einem HauptroboterkGrper (2); 

b) ane Sollwerteinstelleinrichtung (6, 8-10) 
zum Einsteilen eines Sollwerts (Xc, Xc, Xc), 
ausgedruckt in einem Absolut-Koordinatensy- 
stem in dem Tragheitssystem des Arms; 

c) Detektiermittel (14, 19) zum Ermitteln einer 
Geschwindigkeit oder einer Beschleunigung; 
und 

d) eine Steuereinrichtung (11) zum Kbrrigieren 
des von der Sollwerteinstelleinrichtung (6, 8- 
10) kommenden Sollwerts ansprechend auf 
AusgangsgrOBen der Detektiermittel (14, 19) 
und zum Antreiben des Roboterarms nach 
MaBgabe des so korrigierten Werts, 

45 dadurch gekennzeichnet, daS 

e) der Roboter in dem Tragheitskoordinatensy- 
stem frei beweglich ist und 



35 
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55 2. 



f) die Detektiermittel (14, 19) eine erzwungene 
Bewegung des HauptroboterkOrpers, ausge- 
druckt in einem lokalen Roboterkoordinatensy- 
stem, erfassen. 

Steuervorrichtung nach Anspruch 1, bei der die 
Detektiermittel einen Geschwindigkeitsmesser 
(19), der in dein Hauptroboterkflrper angebracht ist. 
und einen Integrator (18) zum Erzeugen eines Stel- 
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iungssignals aus ein 
Geschwindigkeitsmessei 



y^Aui 



sgangsgrOBe des 
eisen. 



3. Steuervorrichtung nach Anspruch 1 Oder 2, bei der 
die Detektiermittel auBerdem aufweisen: eine Koor- 
dinatenumwandlungs-Recheneinrichtung (4) 2um 
Umwandein einer Geschwindigkeit und einer Stel- 
lung, ausgedruckt in dem Roboterkoordinatensy- 
stem, in eine Geschwindigkeit bzw. eine Steilung, 
ausgedruckt in dein Absolut-Koordinatensystem. 

4. Steuervorrichtung nach Anspruch 1, bei der die 
Detektiermittel aufweisen: einen Beschleunigungs- 
messer (14), der in dem HauptroboterkOrper ange- 
ordnet ist, und einen zweistufigen Integrator (17, 
18) zum Erzeugen sowohl eines Geschwindigkeits- 
signals als auch eines Stellungssignals aus einer 
AusgangsgrOBe des Beschleunigungsmessers. 

5. Steuervorrichtung nach Anspruch 4, bei der die 
Detektiereinrichtung weiter aufweist: eine Koordi- 
natenumwandlungs-Recheneinrichtung (4) zum 
Umwandein einer in dem Roboterkoordinatensy- 
stem ausgedrvickten Beschieunigung, Geschwin- 
digkeit und Steilung in eine in dem Absolut- 
Koordinatensystem ausgedrQckte Beschieunigung, 
Geschwindigkeit bzw. Steilung. 

Revendications 

1 . Un disposrtif de commande pour un robot dans un 
systeme inertiel de coordonnees, comprenant : 

a) un robot presentant un bras (3) dans un 
corps principal (2) de ce robot 'edit bras pou- 
vant Qtre entraTne ; 
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b) des moyens de rgglage de valeurs d£sir£es 
(6, 8-10) pour r6gler une valeur desiree (Xc. 
XC, Xc) exprim6e dans un systeme de coor- 40 
donnees absolues dans le systeme inertiel 
dudit bras ; 

c) des moyens de detection (14, 19) pour 
detecter une vitesse ou une acceleration ; et 45 

d) des moyens de commande (11) pour corri- 
ger ladtte valeur desiree & partir desdits 
moyens de reglage de valeurs desirees (6, 8- 

10) en reponse aux signaux de sortie desdits so 
moyens de detection (14, 19) et pour entrainer 
ledit bras de robot en accord avec la valeur 
ainsi corrigee, 



f) lesdits "^B> de detection (14, 19) detec- 
ted un mo^^ient & force du corps principal 
du robot exprime dans un systeme de coordon- 
nees locales du robot. 



Un systeme de commande pour un robot selon la 
revendication 1, dans lequei lesdits moyens de 
detection comprennent un compteur de vitesse (19) 
monte dans ledit corps principal du robot ainsi 
qu'un integrateur (18) pour produire un signal de 
position k partir d'un signal de sortie dudit compteur 
de vitesse.. 

Un disposrtif de commande pour un robot selon la 
revendication 1 ou 2, dans lequei lesdits moyens de 
detection comprennent en outre des moyens de 
caicul de conversion de coordonnees (4) permet- 
tant de convertir une vitesse et une position expri- 
mees dans ledit systeme de coordonnees du robot 
en une vitesse et une position exprimees dans ledit 
systeme de coordonnees absolues. 

Un disposrtif de commande pour un robot selon la 
revendication 1, dans lequei lesdits moyens de 
detection comprennent un acceierometre (14) 
monte dans le corps principal du robot et un inte- 
grateur (2) k deux etages (1 7, 18) pour produire £ la 
fois un signal de vitesse et un signal de position & 
partir d'un signal de sortie dudit acceierometre. 

Un disposrtif de commande pour un robot selon la 
revendication 4, dans lequei lesdits moyens de 
detection comprennent en outre des moyens de 
caicul de conversion de coordonnees (4) pour con- 
vertir une acceleration une vitesse et une position 
exprimees dans ledit systeme de coordonnees du 
robot en une acceleration une vitesse et une posi- 
tion exprimees dans ledit systeme de coordonnees 
absolues. 



caract6ris6 en ce que 



55 



e) ledit robot peut se depiacer librement dans 
ledit systeme inertiel de coordonnees, et 
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